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This  research  is  to  develop  and  demonstrate  the  capability  for 
\'a  manipulator  system  to  automatically  compensate  for  random  motion  of  the 
object  being  manipulated.  This  is  done  by  means  of  a  computer  and  a 
"measurement  armt" ,  a  multi-degree-of-freedom  position  sensor  independent 
of  the  manipulator  itself. 

Following  preliminary  experiments  <of  Dr.  K.  Taniy which  pre¬ 
supposed  perfect  measurement,  we  developed  the  position  sensor  and  the 
Jacobian  matrices  of  approximation  necessary  to  interject  and  transform 
the  measurement  to  enable  control.  This  report  describes  the  interaction 
of  the  6  degree-of-freedom  sensor,  and  the  Jacobian  matrices  of  first 
order  approximation.  Evaluation  tests  were  done  for  simple  motions. 

As  the  result  of  the  tests,  we  found  the  errors  acceptable,  and  believe 
that  this  technique  is  useful  for  this  type  of  compensation. 
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CHAPTER  1 


INTRODUCTION  TO  SUPERVISORY  MANIPULATION 

1. 1  Supervisory  Control 

Recently  the  need  has  increased  for  operating  vehicles  and 
devices  far  from  the  surface  of  the  earth. such  as  underwater  submersibles 
and  space  shuttles.  fhese  operations  are  so  difficult  that  fully  unmanned 
systems  can  not  carry  out  them.  Consequently,  for  these  operations  the 
'  man  is  required  to  be  within  the  systems  to  make  some  decisions.  These 
manned  systems  are  divided  into  two  categories:  one  is  direct  control  and 

-,.j  -  i 

^  ■  .  / 

another  is  supervisory  control.  We  can  explain  the  difference  as  follows, 
by  making  use  of  Fig.  1.1. [1]  In  direct  control,  the  human  directly  con¬ 
trols,  over  the  communication  link,  the  separate  propulsive  actuators  of 
the  vehicle,  the  actuators  for  the  separate  degrees  of  freedom  of  the 
manipulator  and  the  actuators  of  the  video  camera.  The  video  picture  is 
sent  back  directly  to  the  operator.  The  "hand  control"  can  be  a  master- 
slave  positioning  replica  or  a  rate  joystick.  In  supervisory  control  a 
computer  is  added  to  the  teleoperator,  and  for  short  periods  and  limited 
circumstances  the  teleoperator  can  function  autonomously.  Then  the  ter¬ 
minology,  teleoperator,  is  defined  as  follows:  A  vehicle  having  sensors 
and  actuators  for  mobility  and/or  manipulation,  remotely  controlled  by  a 
human  operator,  and  thus  enabling  him  to  extend  his  sensory  -  motor  func¬ 
tion  to  remote  or  hazardous  environments. 

One  example  of  direct  control  is  the  conventional  master  -  slave 
arm  system,  where  the  operator  has  to  make  all  decisions  for  control  on 
the  basis  of  all  information  from  teleoperator  in  a  short  time.  It  will 


computer 


remote 

ccmputer 


vehicle 


make  him  do  too  such  work  and  might  lead  to  misoperations  in  complicated 
systems.  Alternatively,  supervisory  control  may  be  advantageous  to 
achieve  faster  or  more  accurate  control,  or  to  control  simultaneously  in 
more  degrees  -  of  -  freedom  than  the  operator  can  achieve  by  direct  control, 
or  relieve  him  of  tedium.  This  is  why  a  computer  is  included  to  carry  out 
a  part  of  the  work  in  addition  to  the  operator.  Strictly  speaking  these 
computer  roles  are  divided  into  four  categories,  as  in  Fig.  1.2  [1]: 

1)  it  can  extend  his  capabilities  to  help  the  teleoperator 
accomplish  more  than  he  alone  were  in  control. 

2)  it  can  relieve  him  of  some  control  tasks. 

3)  it  can  provide  back-up  by  taking  over  control  for  a  short 
time  if  feedback  is  lost. 

4)  it  can  replace  him  when  a  task  is  too  dull. 

We  have  explained  supervisory  control  so  far  in  comparison  with 
the  counterpart  which  is  the  manned  direct  control  without  computer.  Next 
it  is  also  important  to  explain  supervisory  control  in  comparison  with  the 
work  of  divers  or  manned  submersibles  in  the  sea. 

About  ten  years  ago  divers  seemed  to  have  an  advantage  over 
manned  work  -  vehicles  with  manipulators  in  terms  of  maneuverability, 
manipulation,  tactible  sensing,  and  covertness.  Because  of  smaller 
unmanned  vehicles  and  computers,  only  manipulation,  sensing  and  cognition 
still  remain  the  primary  advantage  for  the  divers. 

As  to  the  comparison  between  teleoperators  and  manned  submersibles, 


because  of  the  remarkable  progress  in  television  cameras  and  communication 
channels,  the  major  difference  remaining  between  manned  submersibles  and 


Seles  of  Computer 

(L-load  or  task,  H-human,  C- computer) 


Extend 


Relieve 


ceieoperators  are  cost  and  safety.  The  pressure  vessel  and  life-support 
equipment  aa.<»  the  manned  submersible  much  more  costly  than  the  same 
vehicle  without  the  pressure  vessel  and  life-support  equipment  but  with 
remote  control  instead. 

The  above-mentioned  explanations  show  that  supervisory  control 
is  getting  to  have  an  advantage  in  terms  of  technology  and  cost  compared 
with  divers  and  manned  submersibles. 

1.2  Compensation 

Thera  are  many  problems  to  be  solved  in  the  field  of  the  super¬ 
visor;;  control.  As  an  example,  in  the  project  we  concentrate  on  remote 
manipulation  by  the  supervisory  control,  particularly  on  manipulation  with 
automatic  compensation,  which  belongs  to  the  1st  category  in  computer  roles 
said  in  1.1,  for  moving  targets. 

As  far  as  compensation  is  concerned,  a  first  step  has  been 
achieved  so  far  in  our  laboratory  by  Tani.[2]  His  work  demonstrated  that 
automatic  manipulator  compensation  for  relative  motion  between  manipulated 
object  and  manipulator  base  made  master  -  slave  manipulation  easier.  For 
his  work,  he  used  a  hardware  system  which  consisted  of  master/slave  mani¬ 
pulator,  a  moving  table  for  the  moving  objects,  and  a  computer  controlling 
both  the  manipulator  and  the  table.  By  means  of  the  method  of  resolved 
motion  rate  control,  his  software  system  allowed  the  master/slave  operation 
with  object  motion  compensation  under  computer  control.  Tani's  experiments 
were  of  three  kinds:  no  object  motion,  compensation  for  the  object  motion, 
and  no  compensation.  The  comparison  of  the  situations  with  the  compensa¬ 
tion  without  it  showed  that  the  compensation  reduced  the  operation  time  or 


increased  the  accuracy  in  some  tasks. 


CHAPTER  2 


PURPOSE  OF  THIS  RESEARCH 

2.1  Compensation  with  Position  Measuring 

The  manipulator  compensation  done  so  far  presupposed  a  perfect 
measurement  of  the  relative  motion  between  manipulated  object  and  mani¬ 
pulator  base.  The  purpose  of  this  project  is  to  extend  the  compensation 
by  using  an  experimental  6  degree-of-freedom  passive  "measurement  arm" 
having  a  simple  gripper,  but  otherwise  flaccid,.  The  operator  positions 
it  with  the  actual  manipulator.  We  explain  it  in  Fig.  2.1. 

A  =  T  +  R  (2.1) 

where 

A:  Absolute  Position  of  the  Object  with  respect 
to  the  Manipulator  Base 

T:  Table  Position  with  respect  to  the  Manipulator 
Base 

R:  Relative  Position  of  the  Object  with  respect 
to  the  Table 

As  shown  in  Fig.  2.1. a,  in  the  case  that  the  table  where  the 
object  is  mounted  is  fixed,  all  the  operator  has  to  do  is  to  pick  up  and 
place  the  object  with  direct  visual  feedback.  On  the  other  hand,  as  shown 
in  Fig.  2.1.b,  in  the  case  that  the  table  moves,  he  is  required  to  do  more 
to  achieve  the  same  operation.  That  is,  as  we  showed  in  Fig.  2.1.c  he  has 
to  pick  it  up  and  to  place  it  by  taking  account  of  the  movement  of  both 
table  and  object.  If  there  were  some  function  which  enabled  him  to  operate 
as  if  the  table  were  fixed,  it  would  be  very  convenient  for  him. 


Measurement  Arm 


In  this  project,  I  define  compensation  as  this  function.  Accord¬ 
ing  to  the  above  mentioned  notation,  the  compensation  means  to  change  A 
from  I  +  R  to  R.  In  other  words  it  means  subtraction  of  T  from  A. 

2.2  Function  of  Measurement  Arm 

-+■  -+■ 

When  it  comes  to  subtraction  of  T  from  A,  T  has  to  be  measured 
while  A  can  be  controlled  by  the  operator.  In  order  to  measure  T,  that 
is,  table  position  with  respect  to  the  manipulator  base,  we  introduced 
the  measurement  arm  to  the  system.  Fig.  2.2  by  means  of  6  potentiometers, 
are  set  in  each  joint  of  the  arm,  we  can  measure  each  joint  angle;  there¬ 
fore,  we  can  estimate  the  position  and  orientation  of  the  table  with  the 
help  of  some  geometrical  calculations.  With  the  aid  of  computation  and 
by  making  use  of  the  measurement  arm,  the  operator  can  pick  up  and  place 
the  object  on  the  moving  table  as  if  the  table  were  fixed. 


CHAPTER  3 


METHOD 


3.1  Control  Theory  of  Manipulation 

At  first,  we  explain  the  control  of  manipulation.  It  is  the 
control  of  A:  Absolute  Position  of  the  Object  with  respect  to  the  Mani¬ 
pulation  Base,  illustrated  in  Chapter  2.  In  Sec.  3.1  the  general  method 
is  stated  and  in  Sec.  3.2  the  approximated  method  we  used  is  stated. 

Generally  speaking,  an  unconstrained  rigid  body  has  six  indepen¬ 
dent  degree  of  freedom:  three  independent  translation  components  and  three 
independent  rotation  components. [3] 

Since  the  hand  of  a  manipulation  is  rigid  body,  it  needs  six 
independent  components  to  be  fixed  in  the  space.  We  define  the  following 
six  components:  x,  y  and  z  which  show  the  translation  P  of  the  hand  and  a, 
8  and  y  which  show  the  orientation  or  rotation  of  the  hand.  In  order 
to  describe  these  six  parameters,  we  use  the  coordinate  system  whose  nota¬ 
tion  is  given  by  T.  Brooks. [4]  Matrix  mAn  means  the  transformation  from 
the  m  th  frame  to  the  n  th  frame.  For  example  the  transformation  from  the 
hand  frame  (6  th)  to  the  vehicle  frame  (0  th)  is  given  as 


Each  frame  is  defined  in  Fig.  3.1  and  components  of  each  matrix  are  shown 
in  Table  A.l. 

According  to  this  notation,  x,  y  and  z  are  the  vehicle  coordinates 

at  point  P.  With  the  definitions  that  the  x  axis  means  the  x  axis  in  the 
r  m 
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40.0” 


Angles  9.  are  the  rotations 
of  coordinate  frame  k.  Angl 
are  assumed  zero  as  shown. 


4y5y 


Fig.  3.1  Definitions  of  Coordinate  Systens  and  Rotation  Angles  of  the 
Manipulator  (from  Brooks  [4] ) 


•Mm 


m  th  frame  and  the  xmym  plane  means  the  plane  containing  the  axis  and 

the  y  axis,  we  define  the  rotation  a,  3  and  y  in  Fig.  3.2.  The  rotation 
m 

a  is  the  angle  between  the  yQzQ  plane  and  the  plane  which  contains  the 
axis  and  which  is  perpendicular  to  the  xQy0  plane.  The  rotation  a,  3  and 
y  are  defined  in  Fig.  3.2. 

If  all  joints  9p  through  9#  (B^  specifies  the  rotation  of  the  k 
th  frame  with  the  respect  to  the  k  -  1  the  frame)  are  given,  these  six 
parameters  are  found  as  follows. 
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In  contrast  with  above  procedure,  it  is  difficult  to  find  9^ 
through  9g  when  x,  y,  z,  a,  6  and  y  are  given.  Since  we  want  to  keep  the 
orientation  of  the  hand  parallel  to  the  xQy0  plane,  we  have  to  give 


8-0 


(3.8) 


y  -  0 


(3.9) 


From  those  equations,  we  find  9^  and  9^  as  follows.  From  equations  (3.4) 
and  (3.5),  B  -  0  and  y  -  0  mean  z.  -  z  ■  0  and  z,^  -  z  -  0,  respectively. 
That  is, 
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65=  tan  1  [-(sin6^  cos 9^  cos9^  +  cos0^  cosS^  sin0^  cos 9^ 
+  cos 9^  sln02  sin0^)/(cos0^  cosO^  cosO^  -  sinO^  slnS^)] 


(3.10) 
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-  sin©.  sin©.)  cos0  -  (sin©,  cos©.  cos©,  + 
13  5  13  4 


cos 0.  cos9  sin©.  cos9.  +  cos©,  sin©,  cos©.) 
1  2  3  4  1  2  4 


sin©^] 


(3.11) 


2^  Q 

Where  mn  represents  an  element  in  matrix  A  .  On  the  other  hand,  from 

6 

(3.3)  a  is  expressed  as 
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+  sin©^  cos©^  tan©^]/ [cos©^  cos©^  cos©^ 


-  sin©.  sin©.  3in0,  -  sin©,  cos©  sin©  cos© 

1  2  4  1  2  3  4 


■(cos©^  sin ©2  +  sin©^  cos  ©^  cos©^)  tan  9  ] 


(3.12) 


22 


To  eliminate  9  ,  substitution  of  (3.10)  to  (3.12)  gives 


tan  a  =>  (-cos9,  cos9  sin9  -  sinS  sin0  coso 
13  4  12  4 


+  sin9.  cos9  sin9  sin0  )/(cos0  cos0 
1  2  3  4  2  4 


+  sin 6  sin0  sin0  ) 
2  3  4 


(3,13) 


3y  means  of  S  instead  of  ,  we  define  P. 


P  ■  S(cosQ^  cos9^  +  sinQ^  sin0^  sin0^) 


+  sin  0,  sin0  cos9  +  cos6  cos©  sin0 
12  4  13  4 


-  sin0,  cos0.  sin0„  sin9 
12  3  4 


(3.14) 


Now  that  we  give  four  parameters:  x,  y,  z  and  P,  to  find  9  through  3^ , 
the  equations  are  rearranged  as 

x  »  1.39  (sin9„  sin9,  cos0.  -  cos9„  sin9,)  -  40  sin0  cos0„ 

2  j  4  2  4  2  3 


(3.15) 


y  *  1.39  (cos0  cos0  cosj  -  sin0  cos0  sins  cos0 
1  j  4  1  2  "3  4 


-  sin9  sin3  sino  )  +  40  (sin9  cos9  cos8 
12  4  12  3 


+  cos0,  sin9)  +  13  cos9 
13  1 


(3.16) 


Z  *  1.39  (sin9..  cos9,  cos9.  +  cos9.  cos9„  sin9.  cos9 

1  3  4  1  2  3  4 


+  cos9  sia9  sin9)  +  40  (-cos9  cos9  cos9 
12  4  12  3 


+  sin9  sin9  )  +  18  sin9 
13  1 


(3.17) 


P  ■  S(cos9.  cos 9 ,  +  sin9_  sin 9,  sin0.) 

2  4  2  3  4 


+  s±n9,  sin9„  cos9  +  cos9  cos9^  sin9 
12  4  13  4 


-  sin9,  cos9„  sin0„  sin9, 
12  3  4 


(3.18) 


It  is  quite  difficult  to  solve  equations  (3.15)-(3.18) ,  then  we  introduce 
the  relation  between  the  total  differential  and  the  partial  differential 
of  a  function. [5] 

The  total  differential  of  f  is  defined  by  the  equation, [6] 


df  -  —  dx  +  dy  +  ii  dz 
0x  9y  3z 


(3.19) 
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where  f  is  a  function  of  three  variables  x,  y  and  z,  and  -7-^  is  the  partial 


derivative  with  respect  to  x. 

If  x,  y  and  z  are  all  functions  of  a  single  variable,  say  t, 
then  the  dependent  variable  f  nay  also  be  considered  as  truly  a  function 
of  the  one  independent  variable  t. 

Since  only  one  independent  variable  is  present,  df/dt  has  a  meaning  and 
it  can  be  shown,  by  appropriate  limiting  processes,  that 


df  „  _3f.  dx  ■  +  _3f_  dv  +  _3f_  dz_ 
dt  3x  dt  3y  dt  3z  dt 


For  a  short  period  of  time  it,  it  can  be  replaced  by 


Af  ^  3f  Ax  |  3f  Ay 
At  3x  At  3y  3t 


3f  Az 
Az  At 


Consequently,  we  get 


Af  *  f  Ax  +  f  Ay  +  f  Az 

x  y  Ct 


where  f  =  3f/3x. 
x 


Applying  the  relation  to  our  problem  gives 


’Ax* 

\ 

X„  X  X. 

2  3  ,4 

1 

t> 

CD 

M 

- 1 

Ay 

— 

yi 

y2  ; 

f 

A8, 

Az 

z 

i 

A0 

1 

t 

3 

Ap 

pr 

- P4. 

A0 

- 

x 

L  x 

y 

L 

Ax 


J<9) 
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(3.20) 


(3.21) 


(3.22) 


(3.23) 


Provided  that  |j(9) j  *  0,  we  have 


- 1 

o 

CD 

M 

_ 1 

"ax" 

£0, 

+  -1 

Ay 

-  J(8) 

A93 

Az 

1 

<D 

o 

1 

Ap 

Each  component  of  Jacobian  matrix  is  shown  in  Table  A. 3 . 


(3.24) 


3.2  Jacobian  of  1st  Order  Approximation 

By  looking  over  components  of  the  Jacobian  matrix,  we  find  it 

contains  many  trigonometric  functions .  Decreasing  the  trigonometric 

functions  in  number  will  cause  more  efficiency  in  terms  of  mechanism  and 

time  for  calculation.  Then  we  introduce  the  appropriate  Jacobian  matrix 

so  that  we  may  eliminate  the  trigonometric  functions,  provided  that  0  is 

limited  in  the  neighborhood  of  9  :  9  (-  9  -  9  )  is  small. 

Os  o 

At  first  we  consider  the  0th  order  approximation:  sin9g  and 
cos9  are  expressed  as  sin0  ■  0  and  cos0  »  1,  that  is, 

3  *  S 


sin  9  ■  sin  (9  +  0  )  ■  sin9 

os  o 

cos  9  *  cos  (9^  +  9  )  *  cos9^ 
os  o 


(3.25) 


The  0th  order  approximation  makes  Jacobian  matrix  constant  so 
that  we  do  not  need  estimate  it  after  the  manipulator  starts  moving  as 
well  as  we  get  9  with  ease.  But  it  causes  much  error. 
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The  1st  order  approximation:  sin  8^and  cos  9^  are  expressed  as 

sinQ  *  8  and  cosQ  =*  1,  that  is, 
s  s  s 


sinQ  =*  sin  (8  +  9  )  ■  sin6  +  9„  cos8 
os  o  s  o 


cos8  *  cos  (9  +  9  )  *  cos0  -  9  sin6 

os  o  s  o 


(3.26) 


This  approximation  has  less  complicated  calculation  th*n  the  conventional 
one  and  less  error  than  the  Oth  .order  approximation.  The  final  form  we 
get  is  expressed  as 


(Ax,Ay,Az, Ap) [C  ]  9 

n  3s 


- 

Ax  [C  ] 9 
n  s 

~r^rz 

D  9. 


(3.27) 


where 


(D1’D2,D3’V  0- 


9  -  9  -  9 

s  o 


-  .  -T1 
J(9)  «  D  *9 


[C  ]  is  constant 
n 


mm** 


Next,  as  an  example  or  higher  order  approximation,  we  consider 


the  2nd  order  approximation  sin@  and  cos  9  are  expressed  as  sin8  *  3 
a  2  s  s  S  S 

v 

and  cos 3  ■  1 - —  that  is, 

s  2 


sin  9  *  sin  (0„  +  0  )  *  (1 - — )  sin 3  +  3  cos3 

os  2  os  o 


(3.28) 


cos  9  ■  cos  (9  +  9  )  ■  (1  -  — =r~)  cos9  -  9  sin0 


o  s 


os  o 


These  equations  prove  that  the  higher  order  approximation  needs  more 
complicated  calculation  compared  with  the  Oth  and  1st  order  ones ,  though 
it  is  more  accurate.  Accordingly,  we  conclude  that  the  1st  order  is  the 
most  appropriate  in  terms  of  simplicity  and  accuracy.  The  components  of 
the  1st  order  approximation  are  expressed  as 


TM:v;4  1 


i 


In  reference  to  0  and  9  ,  they  are  much  influenced  by  the  posture 
5  6' 

of  the  hand  so  that  they  change  more  than  others.  Therefore,  introducing 
the  approximate  calculus  for  9^  and  0g  is  not  suitable.  So  we  get  9.  and 
9^  by  the  basic  expression. 


-5  •  f(91,  02*  S3*  94)*  9 6  "  f(0l»  92 *  03»  04 ’  85) 


(3.35) 


,  9  ),  consequently 


According  to  those  methods,  we  can  get  (9  ,  “  “ 

x,  y,  z  and  S  by  means  of  equations  (3.15)  -  (3.18) 
As  the  result,  we  can  control  A. 


3.3  Compensation 

.According  to  Chapter  2,  T  is  measured  by  the  measurement  arm. 

We  show  the  basic  idea  of  measuring  the  position  and  orientation  of  the 
table.  The  measurement  arm  consisted  of  6  joints  all  of  which  are  rota¬ 
tional  pairs.  In  practical  use,  the  extreme  distal  link  is  kept  perpendi¬ 
cular  to  the  horizontal  plane.  On  this  condition,  we  can  get  x,  y  and  z 
coordinates  of  point  Q  and  angle  a.  For  convenience,  we  define  angles 


(3.36) 


where 


l  »  a  cos  9^*  +  b  sin  (8^'  +  9^) 

9  1  -  tan”1  (l/(tan91  tan02)) 

©^'“-tan  ^  (tanO^/sin©^) 

These  coordinates  are  determined  in  terms  of  the  coordinate  system  which 
is  fixed  in  the  measurement  arm.  However,  they  need  *to  be  expressed  by 
the  common  coordinate  system  which  the  slave  arm  can  use.  In  terms  of 
the  common  system,  point  Q  is  expressed  by 

%  -«x+ta 

Q  ■  Q  +  Ay  /  (3.37) 

y  y  1 

Q  «  Q  +  Az  . 
z  Z 

Where  (Ax,Ay,Az)  means  the  vector  which  shows  the  distance  between  two 
origins  of  coordinate  system. 

a  -  ^  -  (0  ’  -  9  )  (3.38) 

2  2  0 
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Angles  are  assumed  zero 
as  shewn. 


CHAPTER  4 


EXPERIMENTS 

We  mainly  had  two  experiments:  one  was  to  measure  the  accuracy 
of  the  Measurement  Arm;  another  was  to  measure  the  accuracy  of  the  first 
order  of  approximation  of  Jacobian  Matrices  used  for  the  straight-line 
motion  of  Slave  Arm. 

As  to  the  first  one,  we  combined  the  Measurement  Arm  with  the 
Table  illustrated  in  Fig.  2.1.b.  and  made  the  table  move  with  the  distance 
of  Ax(£x,  ly,  1 z)  by  means  of  the  program  MSURE.  As  illustrated  in  Figs.  . 
4.1  and  4.2,  we  got  good  linearity,  with  errors  within  +0 . 15  inch.  This 
is  a  good  result,  considering  the  experimental  mechanism  of  the  Measurement 
Arm. 

Next,  we  tried  to  make  a  straight-line  motion  of  the  Slave  Arm 
by  means  of  program  MAIN.  As  illustrated  in  Fig.  4.3,  we  make  the  arm 
move  from  origin  to  point  p^,  the  distance  x^.  The  results  are  shown  in 
Tables  4.3,  4.4  and  4.5.  For  example,  as  to  the  reference  x^(Ax-^,  0,  0) 
in  Table  4.3,  we  have  the  errors  within  0.09  inch,  0.19  inch  and  0.21  inch, 
along  the  x-axis,  y-axis  and  z-axis,  respectively.  This  is  also  a  good 
result,  considering  that  the  Slave  Arm  mechanism  has  significant  backlash. 
The  errors  along  the  y-axis  are  big  compared  with  others.  It  is  mainly 
caused  by  the  backlash  of  the  angle  6^. 

In  Figs.  4.1.c.  and  4.2.c.  we  can  see  the  increase  in  error,  it 
is  because  the  z-axis  of  the  Measurement  Arm  is  not  in  parallel  with  the 
z-axis  of  the  Table. 
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TABLE  4.1 


ACCURACY  OF  MEASUREMENT  ARM 


b)  Modified 

Data  1  2. 

y  =■  O’  z 

»  0 

i  inch 

x  inch 

y  inch 

z  inch 

s  | 

X 

n 

0 

0.00 

0.00 

0.00 

0.000  1 

1 

1.04 

-0.06 

0.07 

0.009  J 

2 

2.02 

-0.07 

0.14 

0.020  1 

3 

2.90 

0.00 

0.21 

0.038  | 

4 

3.82 

0.03 

0.25 

0.062  | 

5 

4.78 

0.11 

0.30 

0.094  1 
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TABLE  4.2 


ACCURACY  OF  MEASUREMENT  ARM 


a)  Measured  Data  =  Q,  m  Q 


i  inch 

y 

x  inch 

y  inch 

z  inch 

S 

0 

3.74 

-12.71 

3.70 

0.812 

1 

3.71 

-11.79 

3.74 

0.815 

2 

3.74 

-10.80 

3.77 

0.807 

3 

3.79 

-  9.76 

3.79 

0.811 

4 

3.83 

-  8.71 

3.80 

0.823 

5 

3.84 

-  7.77 

3.80 

0.842 

b)  Modified 

Data  i  n , 

x  -  0 

l 

z  *  0 

l  inch 

y 

x  inch 

y  inch 

z  inch 

S 

0 

0.00 

0.00 

0.00 

0.000 

1 

-0.03 

0.92 

0.04 

0.003 

2 

0.00 

1.91 

0.07 

-0.005 

3 

0.05 

2.95 

0.09 

-0 . 001 

4 

0.09 

4.00 

0.10 

0.011 

5 

0.10 

4.94 

0.10 

0.030 

TABLE  4.4 


Accuracy  of  Approximation  x^,  Ax^  *  Az^ 


a)  Measured  Data 


-0.00 

-0.06 

-0.01  1 

5 

-0.02 

0.32 

-0.03  a 

-0.07 

0.88 

-0.09  j 

-0.02 

1.74 

-0.15  1 

-0.07 

2.84 

0.19  ] 

-0.06 

3.87 

0.26  j 

b)  Modified  Data 

inch 

1 

X 

y 

z 

0.00 

0.00 

0.00 

5 

-0.02 

0.38 

-0.02 

-0.07 

0.94 

-0.08 

-0.02 

1.80 

-0.14 

-0.07 

2.90 

0.20 

-0.06 

3.93 

0.27 

■y ■|n iui.p n  i,  m  p,u.  im\p 


ism 


TABLE  4.5 


Accuracy  of  Approximation  x^,  Ax^  *  Ay^  *  0 


a)  Measured  Data 


inch 


A z 

i 

X 

y 

z 

0 

-0.00 

-0.06 

-0.01 

0.2 

0.03 

-0.22 

0.13 

0.5 

-0.04 

-0.16 

0.45 

1 

0.01 

-0.31 

0.97 

2 

-0.05 

-0.30 

1.97 

3 

0.01 

-0.55 

2.90 

b)  Modified  Data 

inch 

Azi 

X 

y 

z 

0 

0.00 

0.00 

0.00 

0.2 

0.03 

-0.16 

0.14 

0.5 

-0.04 

-0.10 

0.46 

1 

0.01 

-0.25 

0.98 

2 

-0.05 

-0.24 

1.98 

3 

0.01 

-0.49 

2.91 
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TABLE  4.6 


Accuracy  of  Approximation  X2,  y 2 


a)  Measured  Data 


inch 


Ax2  x 

y 

z 

0  2.92 

-2.22 

1.15 

0.5  3.46 

-2.50 

1.20 

1  3.93 

-2.19 

1.14 

2  4.90 

-2.32 

1.28 

3  5.82 

-2.26 

1.36 

4  6.88 

-2.43 

1.63 

b)  Modified  Data 

inch 

Ax2  x 

y 

z 

0  0.00 

0.00 

0.00 

0.5  0.54 

-0.28 

0.05 

1  1.01 

0.03 

-0.01 

2  1.98 

-0.10 

0.13 

3  2.90 

-0.04 

0.21 

4  3.96 

-0.21 

0.48 
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TABLE  4.7 


Accuracy  of  Approximation  x^,  3  0 


a)  Measured  Data 


inch 


^2 

X 

y 

2 

0 

2.92 

-2.12 

1.14 

0.5 

2.94 

-1.84 

1.09 

1 

2.93 

-1.43 

1.10 

2 

3.00 

-0.48 

1.11 

3 

3.00 

0.73 

1.05 

4 

2.88 

1.77 

1.16 

b)  Modified  Data 

inch 

Ay2 

X 

y 

z 

0 

0.00 

0.00 

0.00 

0.5 

0.02 

0.28 

-0.05 

1 

0.01 

0.69 

-0.04 

2 

0.08 

1.64 

-0.03 

3 

0.08 

2.85 

-0.09 

4 

-0.04 

3.89 

0.02 
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TABLE  4.8 


Az. 


Accuracy  of  Approximation  x^ ,  Ax?  *  iy2 
a)  Measured  Data 


0.00 

0.00 

0.00 

-0.14 

0.07 

0.39 

-0.04 

0.02 

0.86 

-0.08 

-0.32 

1.91 

-0.14 

-0.49 

2.89 

-0.18 

-0.74 

3.85 
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inch 


X 

y 

z 

3.00 

-2.32 

1.19 

i  2.87 

-2.25 

1.58 

2.96 

-2.30 

2.05 

2.92 

-2.64 

3.10 

2.86 

-2.81 

4.08 

2.82 

-3.06 

5.04 

b)  Modified  Data 

inch 

,  * 

y 

z 

o 

i 


«v*r.<v<u* 


Ww, •!*!■?•; 


CHAPTER  5 


CONCLUSIONS  AND  RECOMMENDATIONS 
FOR  FUTURE  WORK 

The  purpose  of  this  research  was  to  extend  the  compensation 
done  previously  by  Tani  which  presupposed  a  perfect  measurement  by  using 
a  sensor. 

For  this  purpose,  as  a  sensor  we  developed  a  6  degree-of-freedom 
passive  Measurement  Arm  having  a  simple  gripper  but  otherwise  flaccid. 

In  addition  to  developing  the  sensor,  we  extended  the  control  method  by 
considering  some  approximated  Jacobian  matrices  instead  of  complicated 
strict  Jacobian  matrices.  Consequently,  we  developed  the  Jacobian  matrices 
of  first  order  approximation  with  no  trigonometric  functions. 

We  performed  two  experiments:  one  was  to  measure  the  accuracy 
of  the  Measurement  Arm  by  moving  the  table;  another  was  to  measure  the 
accuracy  of  the  Jacobian  matrices  of  first  order  approximation  by  moving 
the  Slave  Arm.  The  result  showed  the  capability  of  compensation  with 
the  Measurement  Arm  as  a  sensor. 

Having  developed  the  basic  hardware  and  software  for  compensa¬ 
tion  by  means  of  the  sensor,  we  intend  to  improve  this  compensation  by 
using  these  techniques  in  the  near  future. 

As  an  example  of  future  work,  I  show  the  following  two  programs. 
One  is  the  program  named  TTT,  which  will  keep  the  same  orientation  of  the 
hand  of  the  Slave  Arm  and  the  same  distance  between  the  table  and  Slave 
Arm,  regardless  of  the  position  of  the  table.  This  is  to  test  the  total 
error  caused  by  the  hardware  and  software  of  the  system.  Another  is  the 
program  named  HICOM  which  is  to  extend  Tani's  compensation  by  using  the 


sensor.  These  are  almost  completed  but  not  vet  perfect. 

In  order  to  extend  the  compensation  with  sensor,  we  suggest 
developing  a  program  which  considers  the  errors  caused  by  mechanisms 
such  as  backlash  in  addition  to  present  considerations. 


REFERENCES 


Sheridan,  T.B.  and  Verplank,  W.L.,  "Human  and  Computer  Control  of 
Undersea  Teleoperators",  Man-Machine  Systems  Laboratory  Report, 
Massachusetts  Institute  of  Technology,  July  1978. 

Tani,  K. ,  "Supervisory  Control  of  Remote  Manipulation  with  Compen¬ 
sation  for  Moving  Target",  Man-Machine  Systems  Laboratory  Report, 
Massachusetts  Institute  of  Technology,  July  1980. 

Crandall,  S.H. ,  et.al. ,  "Dynamics  of  Mechanical  and  Electromechanical 
Systems",  McGraw-Hill  Book  Company,  1968. 

Brooks,  T.L.,  "Superman:  A  System  for  Supervisory  Manipulation  and 
the  Study  of  Human/ Computer  Interactions",  Master's  Thesis,  Massachu¬ 
setts  Institute  of  Technology,  May  1979. 

Hildebrand,  F.B.,  "Advanced  Calculus  for  Applications",  Prentice-Hall, 
Inc.  Englewood D  liffs.  New  Jersey,  1976. 

Witney,  D.E.,  "Resolved  Motion  Rate  Control  of  Manipulators  and  Human 
Prostheses",  IEEE  Transactions  on  Man-Machine  Systems,  Vol.  MMS-10, 

No.  2,  June  1969. 


I 

t 

I 

8  APPENDIX  I 

8  TRANSFORMATION  MATRICES 

l 

i 

l 

I 

i 

I 

I 

5 

1 


TABLE  A.l 


Frame  Transformation 


1  0 

0  cos  9^ 

0  sin  , 

0  0 


0  0 

-sin  8^  0 

cos  .  0 

0  1 


cos  0»  0 

0  1 

-sinQ-  0 

0  0 


sin 02  0 

0  18 

cos  ©2  0 

0  1 


1 

0 

0 

0 


0  0  0 

cos03  -sin03  0 

sin0~  cos  9_  0 

0  0  J  1 


cos  0^  -sxn0£ 
sin  9^  cos  9, 

0  0 

0  0 


0  -1.39  sin0, 

0  1.39  cos  9, 

1  -40 

0  1 


1  0 

0  cos  9- 

0  sin0<- 

0  0 


0  0 

-sinOg  0 

cos  9-  0 

0  1 


cos  9,.  0 

o  6  1 

-sin9g  0 

0  0 


COS0g 


0 

0 

0 

1 


51 


9 

E* 


TABLE  A. 2 

Transformation  from  Hand  to  Vehicle 


all 

a12 

a13 

a14 

a21 

a22 

a23 

a24 

a31 

a32 

a33 

a34 

0 

0 

0 

1 

lll 


12 


13 


*14 


l21 


22 


22 


*24 


31 


32 


33 


‘34 


(C2C4  +  S2S3S4)  C6  +  (S2S3C4S5  -  C2S4S5 
-  S2C3C5)  56 

(S2S3C4  -  C2S4)  C5  +  S2C3S5 

(C2S4S5  -  S2S3C4S5  +  S2C)  C6 

+  (C2C4  +  S2S3S4)  S6 

1.39  (S2S3C4  -  C2S4)  -  40  (S2C3) 

(C1C3C4  -  S1C2S3C4  -  S1S2S4)  S5S6  +  (C1S3 
+  S1C2C3)  C5S6  +  (C1C3  -  S1C2S3)S4C6  +  S1S2C4C6 

(C1C3C4  -  S1S2S4  -  S1C2S3C4)  C5  -  (C1S3  +  S1C2C3)  S5 

(S1S2S4  -  C1C3C4  +  S1C2S3C4)  S5C6  -  (C1S3  +  S1C2C3)  C5C6 

+  (C1C3  -  S1C2S3)  S4S6  +  S1S2C4S6 

1.39  (C1C3C4  -  S1C2S3C4  -  S1S2S4)  +  40  (C1S3 

(C1S2S4  +  S1C3C4  +  C1C2S3C4) S5S6  +  (S1S3  -  C1S2C3)  C5 
+  (C1C2S3  +  S1C3)  S4C6  -  C1S2C4C6 

(C1S2S4  +  S1C3C4  +  C1C2S3C4)  C5  +  (C1C2C3  -  S1S3) 

-(C1S2S4  +  S1C3C4  +  C1C2S3C4)  S5C6  +  (S1C3  +  C1C2S3) 
+(C1C2C3  -  S1S3)  C5C6  -  C1S2C4S6 

1.39  (S1C3C4  +  C1C2S3C4  +  C1S2S4)  +  40  (S1S3  -  C1C2C3) 

+  18S1 


where  SI  ■  sino^,  Cl 


cost 
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APPENDIX  II 


JACOBIAN  MATRICES 


TABLE  A. 3 


Jacobian  Matrix 


J(0) 


x 


4 


y3  y4 


where  x^  *  9x/30^. 


y 


1 


y4 


21 


Z2 

z3 


! 


z4 


?! 


0 

1.39  (C2S3C4  +  S2S4)  -  40C2C3 

1.39S2C3C4  +  40S2S3 

-1.39  (C2C4  +  S2S3S4) 

-1.39  (S1C3C4  +  C1C2S3C4  +  C1S2S4) 

+  40  (C1C2C3  -  S1S3)  -  18S1 

1.39  (S1S2S3C4  -  S1C2S4)  -  40S1S2C3 

-1.39  (S1C2C3C4  +  C1S3C4)  +  40  (C1C3  -  S1C2S3) 

1.39  (-S1S2C4  -  C1C3S4  +  S1C2S3S4) 

1.39  (C1C3C4  -  S1C2S3C4  -  S1S2S4) 

+  40  (S1C2C3  +  CIS 3)  +  18C1 

1.39  (-C1S2S3C4  +  C1C2S4)  +  40C1S2C3 

1.39  (C1C2C3C4  -  S1S3C4)  +  40  (S1C3  +  C1C2S3) 

1.39  (C1S2C4  -  S1C3S4  -  C1C2S3S4) 

0  +  C1S2C4  -  S1C3S4  -  C1C2S3S4 

S  (-S2C4  +  C2S3S4)  +  (S1C2C4  +  S1S2S3S4) 

S  (S2C3S4)  +  (-S1C2C3S4  -  C1S3S4) 


i 


Table  A. 3  (Continued) 


K 


8 


p  -  S  (S2S3C4  -  C2S4)  +  (C1C3C4  -  S1C2S3C4 
U  -  S1S2S4) 


where  SI 


sine 


and  Cl 


cos9^. 


1 

1 

s 

8 

I 

8 


% 

hi 


i 

I 

f 
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TABLE  A. 4 


Components  of  Matrix 


1.39  [ (-S30  -  C40)  S20  +  S40C20]  +  40C30S20 

1.39  (C20  +  C40)  C30  +  40C20S30 

1.39  [ (-C20  -  S30)  S40  +  S20C40] 

1.39  (C20S30C40  +  S20S40)  -  40C20C30 


1.39  (C20C30C40)  +  40C20S30 
-1.39  S20S30C40  +  40S20C30 
-1.39S20C30S40 
1.39S20C30C40  +  40S20S30 


1.39  (S20C40  -  C20S30S40) 
1.39S20C30S40 

1.39  (C20S40  -  S20S30C40) 
-1.39  (C20C40  +  S20S30S40) 


where  CIO  *  cosQ^g,  S10  •  sin6^ 


I 
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Table  A.  4  (Continued) 


7  »  -1.39  (C10C30C40  -  S10C20S30C40) 

11  +  40  (-S10C20C30  -  C10S30)  -  18C10 

y  -  -1.39  [aO  (-S20)  S30  C40]  +  40  [CIO  (-S20)  C30] 

7  ,  -  -1.39  [S10  (-S30)  C40  +  C10C20C30C40] 

3  +  40  [C10C20  (-S30)  -  S10C30) 

7,.  -  -1.39  [S10C30  (-S40)  +  C10C20S30  (-S40) ] 

14 

7  -  -1.39  (S10C30C40  +  C10C20S30C40) 

15  +  40  (C10C20C30  -  S10S30)  -  18S10 

7  *  1.39  (C10S20S30C40  -  C10C20S40) 

21  -  40C10S2QC30 

7  -  1.39  [S10C20S30C40  -  S10  (-S20)  S40] 

2“  -  40S10C20C30 

723  -  1.39S10S20C30C40  -  40S10S20  (-S30) 

724  -  1.39  [S10S20S30  (-S40)  -  S10C20C40] 

7  -  1.39  (S10S20S30C40  -  S10C20S40) 

25  -  40S10S20C30 

7 ^  -  -1.39  (C10C20C30C40  -  S10S30C40) 

.+  40  (-S10C30  -  C10C20S30) 

732  «  -1.39  [S10  (-S20)  C30C40]  -  40S10  (-S20)  S30 

733  -  -1.39  [S10C20  (-S30)  C40  +  C10C30C40] 

+  40  [CIO  (-S30)  -  S10C20C30) 

734  -  -1.39  [S10C20C30  (-S40)  +  C10S30  (-S40) ] 

7  -  -1.39  (S10C20C30C40  +  C10S30C40) 

35  +40  (C10C30  -  S10C20S30) 

7  -  1.39  (-C10S20C40  +  S10C30S40 

41  +  C10C20S30S40) 

742  -  1.39  [-S10C20C40  +  S10  (-S20)  S30S40] 

743  -  1.39  [-CIO  (-S30)  S40  +  S10C20C30S40] 


& 
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Table  A. 4  (Continued) 


r44 


45 


'11 


‘12 


'13 


'14 


15 


'21 


'22 


'23 


'24 


25 


'31 


'32 


33 


'34 


35 


1.39  [-S10S20  (-S40)  -  C10C30C40 
+  S10C20S30C40] 

1.39  (-S10S20C40  -  C10C30S40 
+  S10C20S30S400 

1.39  (-S10C30C40  -  C10C20S30C40  -  C10S20S40) 
+  40  (C10C20C30  -  S10S30)  +  18  (-S10) 

1.39  [-S10  (-S20)  S30C40  -  S10C20S40] 

+  40  [S10  (-S20)  C30] 

1.39  [CIO  (-S30)  C40  -  S10C20C30C40] 

+  40  [S10C20  (-S30)  +  C10C30] 

1.39  [C10C30  (-S40)  -  S10C20S30  (-S40) 

-  S10S20C40 

1.39  (C10C30C40  -  S10C20S30C40  -  S10S20S40 
+  40  (S10C20C30  +  C10S30)  +  18C10 

1.39  (S10S20S30C40  -  S1QC20S40) 

+  40  (-  S10S20C30) 

1.39  [-C10C20S30C40  +  CIO  (-S20)  S40] 

+  40C10C20C30 

1.39  (-CIO)  S20C30C40  +  40C10S20 • (-S30) 

1.39  [-C10S20S30  (-S40)  +  C10C20C40] 

1.39  (-C10S20S30C40  +  C10C20S40) 

+  40C10S20C30 

1.39  (-S10C20C30C40  -  C10S30C40) 

+  40  (C10C30  -  S10C20S30) 

1.39  CIO  (-S20)  C30C40  +  40C10  (-S20)  S30 

1.39  [C10C20  (-S30)  C40  -  S10C30C40] 

+  40  [S10  (-S30)  +  C10C20C30] 

1.39  [C10C20C30  (-S40)  -  S10S30  (-S40) ] 

1.39  (C10C20C30C40  -  S10S30C400 
+  40  (S10C30  +  C10C20S30) 
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Table  A. 4  (Continued) 

z41  -  1.39  (-S10S20C40  -  C10C30S40  +  S10C20S30S40) 

z42  =  1.39  (C10C20C40  -  CIO  (-S20)  S30S40] 

z43  -  1.39  [-S10  (-S30)  S40  -  C10C20C30S40] 

z,,  -  1.39  [C10S20  (-S40)  -  S10C30C40  -  C10C20S30C40] 

44 

z45  -  1.39  (C10S20C40  -  S10C30S40  -  C10C20S30S40) 

pu  -  -S10S20C40  -  C10C30S40  +  S10C20S30S40 

P12  -  C10C20C40  -  CIO  (-S20)  S30S40 

P13  -  -S10  (-S30) S40  -  C10C20C30S40 

p14  -  C10S20  (-S40)  -  S10C30C40  -  C10C20S30C40 

p15  =  C10S20C40  -  S10C30S40  -  C10C20S30S40 

p21  *  C10C20C40  +  C10S20S30S40 

p22  *  S  [-C20C40  -  S20S30S40] 

+  SIO  (-S20)  C40  +  S10C20S30S40 

p  -  S  [C20C30S40] 

J  +  S10S20C30S40 

p  »  S  [-S20  (-S40)  +  C20S30C40] 

24  +  S10C20  (-S40)  +  S10S20S30C40 

P,,.  -  S  [-S20C40  +  C20S30S40] 

25  +  S10C20C40  +  S10S20S30S40 

P31  -  -C10C20C30S40  +  S10S30S40 

p.  -  S  [C2QC30S40] 

2  -  SIO  (-S20)  C30S40 

p  -  S  [S20  (-S30)  S40] 

-  S10C20  (-S30)  S40  -  C10C30S40 

P34  -  S  [S20C30S40] 

p  -  S  [S20C30S40] 

35  -  S10C20C30S40  -  C10S30S40 
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Table  4.3  (Continued) 


-  S10C30C40  -  C10C20S30C40  -  C10S20S40 
S  [C20S30C40  +  S20S40] 

S  [S20C30C40] 

+  CIO  (-S30)  C40  -  S10C20C30C40 
S  [S20S30  (-S40)  -  C20C40] 

+  C10C30  (-S40)  -  S10C20S30  (-S40)  -  S10S20C40 

S  [S20S30C40  -  C20S40] 

+  C10C30C40  -  S10C20S30C40  -  S10S20S40 


"MAIN": 


"MSUHE": 


If 


TTT": 


"HICOM" : 


Straight-line  motion  of  Slave  Arm  accord¬ 
ing  to  the  reference  (Ax,  Ay,  Ax,  Act)  in 
Figs.  4.3  and  3.2,  by  means  of  Jacobian 
Matrices  of  1st  Order  Approximation  in 
Secs.  3.1  and  3.2. 

Measurement  of  Point  Q  (x,  y,  z,  a)  in 
Fig.  3.4  which  is  the  extreme  end  of 
Measurement  Arm,  by  means  of  the  method 
in  Sec.  3.3. 

Motion  of  Slave  Arm  so  as  to  keep  the 
constant  distance  between  the  table 
measured  by  "SUBME"  and  Slave  Arm  measured 
by  "SUBS1" ,  regardless  of  the  position  of 
table. 

Extended  Compensation  done  so  far  by 
means  of  Measurement  Arm  as  a  sensor. 


Subroutines  for  "TTT"  and  "HICOM" 

"SUBI",  "SUBO":  Input  and  Output  of  each  angle. 

"SUBSl"  and  "SUBM1":  Present  angle  of  Slave  Arm  and  Master  Arm. 


"SUBS2"  and  "STJBM2M :  Desired  angle  according  to  the  reference 

(Ax,  Ay,  Az,  Act)  for  Slave  Arm  and  for 
Master  Arm. 

"SUBME":  Measurement  of  the  extreme  end  of  Measure¬ 

ment  Arm. 
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nAIN 

COMMON  r-i'J  S !  ?  7  >  • T’-  IT  I  -  “  >  •  r-Y  ZQ ,  7: ,  THXMC  (  7  > 

COMMON  lyfc74<  1*  •• 

DIMENSION  AB<7)  *P,X(4»5)  *PY •-  J . 5'  •  :<*<>'  YY (4» 3)  «ZZ( 4o i  •  ? 

1  X  (  a  > » f  •  4  > » Z 4 ;  •  r  1 « ) » T£  3  ( 5  i 


j  . 


THX50  ( 1  :*  =0 » 0 
7HXnO(  1  ;=0..>' .. 

CALL  Ar-Irtl* 

CALL  rC'UT  (  2  4  •  0 
CALL  i'Ol'T •. 26  >0/ 

TYPE  t-'fiArllP'JLArOR  COMPUTER  CONTROL ' 

ACCEPT  *  *  I 

IF ( I » At  > i )  STOP 

CALL  AINS3(l6*2P* ItATA . 

CALL  AuUTSOv A* 17» IJAT V1 
CALL  ["OUT (' 2 A. *3) 

CONTINUE 

CONTINUE 

TYPE  jj  *  *  C'C  YOU  NEED  ORIGIN  SET? 

ACCEPT  *»«N>n 

if-:nnn.eo.:>  :*o  ro  coo 

TYPE  if  'NO.  OF  .CIO  ♦*  SPEED' 

ACCEPT  *  *  N 
RN=rLOAT ( N ) 

TYPE  it  ‘  POSITION  INCREMENTS  DX«Gt  •GZjIm  INCH  AND  ISjIN  DEG' 
ACCEPT  *-DX.Df •DZ.IS 
CS=PLOA T ( I S  > * < 3 . i 4 1 ; / 1 SO . 0 ) 
ggsTASM  SS ) 


Lr)uL  MANULI 


if  I 


THS1*TH>'5I(?> 

THS2*TWXSI<7) 

THS3»THXSI(®>-THS1 
THS4*THXSI> 2) 

THSS=( THXSH4 j+THX'S I < 3 ) > / 2 . 0+0 . 27* THS3 
THS6= < THXS I ( 4  > -TH/S I <  3  >  > / 1 . 65 

THHl*THXNIt5> 

THM2=THXfiI » 7  > 

THH3*THX«I(p)-THril 

TKMsTHXNI(2) 

7Hri5=<  Tii/h  I '  4  >  f+KYh  1(3) )  '2 . 0+0 . 2?*THN3 
THf?6*( Trtxril ( 4 : - TH xM ( 3)  )/l  .65 

TYPE  if  'IDA?*(1  )-<3) '  ,  , 

TYPE  it  IDATAf.  1 •  IDATAI2J  *  IDATAt  3) 

TYPE  *» 'THS1-3' 

TYPE  *»TK51»THS2f THS3 


TYPE  *• 'PRESENT  TH3 ' 

ITH31=r*INT ( ISO*  j/3.141p)*THS:  > 

I THS2* I N I  NT ( <1 30 . 0/ 3 . 1 4 1 6 ! *THS2 ) 

’THSI3 ININT (  '  130.  ) A3. 1-1  6)  *THS2) 
ITHS-*=t'-IN7(  1  120.0/  3. 1-la  ■  xTHi*»  > 
IThSS-IMZNT  ■  *.  1  £0 . 0,  3 . 1 4ip  > « >35 » 

I  TH  * 6=  I N I MT  (  !  1  g  .'> .  0  /  -T .  1 -»  1  o >  *  THb;  1 

TYPE  *i  r'Ti WS1  •  ITHS2  • !  rHS*  •  I  >34.  I7HS5-  ITHS6 


V- 


.  .  z  '  2’ Hi'"  dcx,*  act 

»rnit  tuily  logihiM  rep:c»i%i:jMfoa 
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■  ■?  *  t  '  A  *  *  • 


1 .3?*i5Tni  TH3Z  T*S2'»i:0S'  7hS4  i 

-COS <  I'.'1  Tr£4 

-40.0*(  3If<(  THS2;  ’CCS  ■  T'i  33)  ■ 


1.3?*;  ccs  <;  the  i  ■  *cf  s  •  T--?3  •  *cc,:  ■  Tns J  • 

-5IM(TkSi ; *CCS«  TH32‘*Sif,<  7rtS3<*C0v  TN5-»: 
-SIN<  TWSl :  *2  In  *  thSC)»SI*:v  ) 

•  0?  \  S  !:•  ‘  THb  1  *  V •  ”  v S  ;  ri-  j 1  ■,  7  Hi  j  ) 

♦CCS <  THSl >  *SlN< TH53) ' 

+  l8.0*;CC'SdHSl )  > 


1 . 39*<  SItf<  THSl >  «COS ; THS3 ) *CC3 ( THS4  ? 

rCOS  (  THSl  >  *COS \  THSi  :■  *Sr^7'-'S3'  «CCS;ThS4, 
-COS i  Thai * S I r; ■.  ~^32 ;  ?SIN>  THS4 )  > 

+40.0*;  -CCS  ■:  THSl 1  <GGS  <  TH.32;  *C0$ '  THS3) 

+SIi*i( THSl.!  *31;-',  7H3J) ) 

+  18.0*SIr/( THSl > 


YP*YP-1?.3? 

ZF*ZP+40.0 


TYPE  s.Xp.YP-ZP 

TYPE  i»  •  (F  INITIAL  SET  HEEDS*  IKf'UT  1 ' 

AC2EF"  *'11 

IFdi.N E.l;  GO  TO  100 


TH501»THSi 
THS02*TH?2 
T'r!S03=TH:  3 
THSC4-THS4 


51*SIN; TH301  ; 
32=3INdHS02> 
S3*SIf+«THSv3i 
S4*SIN(THS04> 


C1=C0£'THS01) 
C2*CCS(TWS02 > 
C3*C0S(THSO3i 
C4*C0S( THS04 / 


XX(1»5)*O.0 
XX(1»1)*0.0 
XX < 1 . 2)=0 .  ' 
XX  (1.3)=:;  .0 
xx;i.4)=o.o 


XX<2*5)=1 .3?*( C2*S3xC4t32*SJ )-40.0*(C2*C3> 
XX (2.1; =0.0 

x'((2f  2)=l . 3?* ( < -5 3-C J  > *S24 ?4*C2 ) +40 . 0*C3*S2 
XX  ( 2 •  3 )  *1 . 3«  *  <  C2+C 4  -  *C 3-40 .  «*C2*83 
XX(2>4)=i ,3?*( (-C2-33)*34+S2*C+) 


xx ;  3 * z)  *1 .  zn ;  32  *c3*c+  )  +*o .  0*  <  S2*S3) 

<X»o» 1 ) =0 . 0 

XX(3f2)»1.3?*<C2*C3*C4>r40.0*(C2*S3) 
XX ( 3 1 3 ) =- 1 . 3 ' * <  32*33 *C 4 )  -*0 . 0*  < 32 «Lj . ) 
XX(3»4)=-1 .39*  ••  32*C3iS4  i 


XX<4»5)»-1.3?*<C2*C4+32*$3+’S4> 


Vits  - 


’iu-W  V:  V' 


*  ■  % ,®.  •.  . ». 1 


8 

6 

1 

8 


§ 


1 

I 

I 


S 

S 

8 


c 

c 


c 

c 


c 


!  i.i; 

.XX  (4, 2: 
Xx  '.At  3.’ 
XX  .4*4) 

rrcif 5)= 

l 

YY  ( I  >  1 )  - 
1 

YY  < 1 » 2  J s 
YYCi»3>s 
1 

YY(1»4): 
YY <2?5>: 

yv<2*l)! 


#  .* 

1.39*-  S2xCJ-CZ*$3f54; 

-1 . 3*  *(32*03. 54  i 

l . .yy* ■v u2xb — ) 

-1 .39*: 31 *03*04+01  *01*53*04)  fJC.O  +  Cl+CIYCo-Sl  +  SS) 
-iS.O+SI 

: "  1  ♦  9 X  v  <-■ 1 *L j*C4  — ^*  1  *L2  4  ;  r 4 ;)  » 1  f  i  f-  So  : 

~  1c  * 

i-i.29<t<C2*(-S2)*S3«C4>fJ'}.C*(C:it(-52)*C3) 
s-t • 3?*<Sl*(-33}*CJ+Cl*C2tC3*C4 . 

+40  -0 i <01*02* < -33 ) -5 1 *  C  3  > 

=-i .3?*( 31*C3*(-S4)+Cl<C2*S3*(-S4) ; 


YY (3.5: 
YY'"-1' 
r  r  ■.  3  -  2  - 


=  - 1  3-  • ' 5  1  *02*03*04+01 *«3KC4 »f  JO. ')* < Cl *02-51  *C2*S3> 
«*t. *®«  C 1*02*03*04-51 n23»C4 * +40.0*< '-51 )*C3-C1«C2»S3) 
--1.3-*  i! i •. -52) *C3*C4  '-JO ♦ 0*SI *  < -32 j  *53 

- —  i 1 *C—  * ■  —  5  -  »>•« 4 rC  1  *0.:  *04  i  rii.1 » v  * • 01  *  “3 ■-> 

i'f  : 

■  - .  .3 > -  2:  *C2*C2*‘.-S4 )  +01*S3*t  -34) ) 


rY-j?J>- 

yv,; 

Y  Y  ( 4 '»  i ) ! 
YY ( 4 • 2 ' s 
YY(4«3/: 
YY'4,4): 


ZZtl»3)*l.  39  * '  •.*  i*C5*C-i-$l*C2ti~  *04  -52  *S2  *04  > 
i  +40 .  :•*  ( 3i  *C2»C3tc:  «S3  >  -  is .  o*c: 

Z  2  ( 1  *  1 )  *  1 . 3  ?  -  •  -  3 1  *  C  3  *  C  4  -  C 1  *  C  2  t  S  3  -  C  4  -  C 1  :*  5  2  •«  5  4 ; 

1  +40  •  '/•-  ■:  -2 1  *C2 *02-31' 3  2  )  + 1 3 . 1  i f.  -3 1  > 

ZZ( 1 • 2)=i .3' 7  -Si  * ( -52 ) *5 3 *04-31*02 *54 ) 

1  +40 . 1  ( S 1  *  <  -5  2  ■  *C  3  1 
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*.'[(2’=Am 
A£=VI<3  < 
E;F=VIM» 

o  i '  j;  =sr> 

VI(4»*Ah 
4A*VI <  Zf 
BS  *VK*» 
vi<S)*e& 

VI(6»»AA 


TO  7  00 


VlAI'IDT f  I)  > 


THD<!'*-20. !)-Cl 
THD( 2)**!'  •  r  ^  2 


-Cl 

THD(3 •*  3) -cir 

THD<4)*-22.  V.T'i  i-i'4 
t-<d(5>*  :o.  :-«vi  5)-r; 
thd<5/*-20.  :-4yi:6)-C6 

n n  "33  I*» . 

*:>d  i ■  *i:<i r<THD; :>> 

CON'TIfWjfe 

Tver  .  D.lTMll'  i) ' 

TYPt  *  •  r Hi  i ? »  TTrtfK  0  > • I~ML ' 3 ) ’ ITHD  •  4 ■ • 
1  IThDi3)  •  ITHD'  O' 


DC 


.1  i: 


0  1*1 1 


rut"  :)»<3.:-i5a/:80.0!«rHt>:i) 

I  *  T  .  - 


71 


I 


* 

> 


» 

I 

> 

I 


I 

> 

t 

I 


I 


2°0 


IF- »£Q.0»0>  21  r>:  270 


3  i  l ;  =-3'3f:T  •:  ( TrN<TKF:  (!>.')  U2i  (  TAN •  THF.  ( 2 
TH 1  -!•-  3  ■  2) 

S(2)*ATAN(! . 0/S < 1 ) ) 


5 < 3 > = <  7At <  T>ift i 2 )  5  )/Slrl(  THR(  1 )  / 


TH2-S*5'4> 
GO  TO  290 


a  i  ' '  s  i'  3 , :  A’  ~ -3  /  2  •  0 » -THR 2 ' 

!F(THP*2> .GT .0.0)  $<•*>*  3.14159/2.0 
IF  t  7Mp  •  2  •  .LT.O.O'  S  (A  >  =-3 . 1 4 159/  2 .  C* 


Ti rup i 2: , £0 , 0 . ) )  GO  TO  900 
CONTtki.- 

l.rC  - 

Sv'5)«DAyC05(5(2)  /tDF*SIN<S(2)+THft(4) ) 


'»>sr/3S<;s(4>  > 

>=[••■  »•=:'  f  ■>  91^9(4) ) 

2  sj  27  -  2  .A  'c- .  * 1  -3 1 2 )  ‘ 

*  I  &3*C0S  <  S  >  J * ThF:  ( 4 )  ;  t  tw ) 


4»;:.l*i59--:.0)-i3(4)-THft'6)) 


»v:c  .  / ’•  v  ▼  a / 

TYr  E  i ^  j  *  p  3 


Xs* *  f-i'v  *  V 
fstti:.' 


IY=IMIN“-  v 


:A*ININT- *»l3v. 0/3. 1*15?) 
TYPE  *.t> .  I Y » IZ»  IF* 


•3  A  A 
V/ 


GO  TO  MO 
T  :*c<: 
l  FOP 
tNO 
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COMMON 

/r,!/  TUV 

CO  rir  OH 

/  k;'”-  / 

C  OriMCN 

/N3> 

t;-n 

/»a/  re a 

COMHCf? 

/NS/ 

7+;. 

COhMCfl 

/Hi/ 

xh  t 

DIMENSION  40‘7) 

CALL  ANINIT 

CALL  SC'JTCAfO) 

CALL  CCLJT  - 26>0'1 

Tv??  *•  CO-PUTtP  CONTROL 

Ar.*£?T  *>I 

IP a.NE.i  •  30  TO  *)0_ 

r c  i  ^  A  -  *  ■  /  *  2^ #  I  '  A ) 

J.  -  .l  aCL'730< 4*  ■'  7*  I  jA  4/ 

'.r.0F.3IV*2?EED' 
r  t  r-  > 

Tver  *.  '.'CID  ORIGIN  SET  »' 

- : c -  - ^  *i'. 

iF- GO  TO  500 

r-*r  a.  gt^.t  ?/ 

ACCtr'T  £•- 
IFiI.NZ.l)  GO  lO  *00 


THS(1)*“:X3I<5) 

THSi2)*TiU:|;(7» 

7H5  ''Z.tS  ~r  '  -  I  •  c )  - '  ~.oi  1 ) 

TWjf  4  '  =  *!-  *21 ' 2  > 

TH3(5)*'T'-i«.;I  :a>»Twx  =  I  '7  ■  2. 0+0.0  *rv>L 
THS*  6i  =  - ~h<3*(4 •-rnX5I* 7 ' <  -  I > j5 

THM<1>*TW?MI'T' 

THH(2  > 

TH*4'3)*T->'1I'  o»-Tri**tl: 

THM^4'  *Twr«IC:  . 

7HM(5'*’’  T  -t>Hl  -  i;  ’■-ur*: :  j-  V2.0-0. 2?«THr 
THM(  4  '<  -  Tnrfll  ;  J  •  .  /’  ..5 5 

TYPE  f . •-tCSt^T  TH5*I»- 

iTHSi»:Nr;^<57.:3«*Th«'  i  ■ 

i  ins  j*  :  :  -*t  •  57 .  ;5o  *  Ti+i  < : 
r thsi» r n ?> * 

ITH5o*;ril  :Ti  J?.  2;s«Tr'i<  a  ■  , 

TrP£  *.  T  -  jl-ITH32fI  T^»7.  :"W«4.  I^SS*.' 

cal.  :  .'?si 

r'tr  +ri'  r,y  *  2y  •  *’2 •  £»  T' 
aC 7t;'T  I  • 

■c  r .  i  t  AC  ;OC 


.if  I 


C 


c 

c 


c 


-V 


5 


i 

I 

i 


» 


’20 


zo 


IF< I. EG. I  >  GO  Tl  :zo 


r/fE  *-  PRE3E?JT  <htt.  h'TT.ZJiTT 
TYPE  it  «MTT.  YrT.rnT’' 

rfPE  NE'J  XpTT»Y*!TT.z,-TT 

accept  s .  i 

Ir( I •*:£.!>  GO  TO  200 

TY't  ».'*£’*  XilTT.YriTT.ZMTT- 
jCti^T  <  ;',“Tr*  rriTT* ZhTT 

'■=m  -  * 

■  S*?  X  ( *'T"i 


rxs»r  -:^t . <?) 

i:s*ir-i>;T  :«» 


T r ?£  ».  iV 

TYPE  ■  S.I?3*  tzs 


type  *.  initial  set 

ACC£F-T 

IFC.f'.-:.;!  30  TO  220 


CALL  Suj.* 
GO  TO  Jfc. 
I.N«2 

2A-l  Slit.* 


FO; 


jo;  .1i 


> ' 


IXpE-INI**  -  ■ 

rrf*€*iMi- '  •  -?  ■ 
rzw*ip:.ir  y.z: 


type  t. I1*'?. :>£.«•>  ■>€ 
TYPE  *•  iXrt*  I>1£. IZflt 


r**£  i.  -C'.'E  ’ 
accept 

:F'!.NC.1>  GO  TO  9)0 


XSj-OtE 

YSt»«T“£ 

3S 0»S3 


TLI-^S-  :  ■ 
n:«TMb(>- 
TLG-TVv 
TL*»r*i . i 
TLS*^  ;■ 
fle»rw«  , 


t-w.Y 


7* 


t«P 


I 


i 

I 

I 

I 

i 

1 

1 

8 

8 

I 

8 

I 

i 

I 

I 

% 

I 

I 

i 


c 

c 

c 

500 


eOC 


C 


r 


id 


ho 


iti=:?;tntutus(  i - t l : '  *er\c3:> 

IT2=Iruf!T . ' THS ( I '  -"I '  *?7 .  r«e  > 
IT>tfcIN7(<7KS  ■:  3  >  -  T L  7  i  * 5  * .  .1  : *  > 
it4«:niht«  :  ths  :  4  ;-tl4-  ,  ;«<? ' 

I75»:nI^T((N'3.  5>-TL?> 

ITS*ININT ( (THS'  o  *5? .Ova) 

TYPE  4t,  IT1 ,  IT2. 173.  IT4»  ITS.  ITa 

GO  TO  aOO 

TH5( 1)*0.0 
THS 1 2 ) *0 . 0 
THS <35*0.0 
THS ( 4 ) *0 . 0 
THS (5) *0.0 
THSv'o'*C.O 

T :  PE  I  RUN  ?' 

AiVrpr  »*t 

IF(I.ME.l)  GC  TO  avO 

THYSO • 1 ; *0 . 0 

THXHO  < 1 ) »0 . 0 

DO  300  J*2.7 

TWVml  •  ia^H  <*I ;  I  > 

CONTINUE 

■rySO.  O''*Tw4.  j) 

7HX SC ‘  *!  *T'riS  .  5'-"m£  ;  *  fO.  ;‘C--TH?'  3  *0. 07 
TWXSQ ( 4  ♦  7-5  f  5 .  *0 . 3:5- THS { 3 )  «0 . 

THXS0<5)»TH«. 1‘ 

THyS0r4i*Tu5^.,**„5v3> 

TMxso<7:*rfS'0) 

TYPE  •. • POINT  1 

:»o  :;i 

AO<I  *THXS0' I)-’HX5I<I; 

continue 

1*1 


TYPE  *. 'POINT  0' 


CONTINUE 

Do  j*;.’ 

’H<5Qt  J)*T'4Y3I  (  j:  t*  All!  J>,  £N  AFLOAT'  I  ) 

CONTINUE 
CALL  SUM 

call  ACjTsa<4.r,:r*T4» 
i»iti 

IP'I.GT.N)  GO  TO  30: 

00  TO  38 

type  «. 'POINT  3' 


CONTINUE 

Tvpr  «•  * 0 1 *•  T  4 

CONTINUE 


Copy  available  to 


f  ”v  ! 


•gihlp  r«prod«c 


•  t  r 
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nno 


PPOusAri 


COMMON  r-XSI'7:  *  THXSI'T^tuy$3<7>.7Hx>^<7i 
CGnhON  The '  ■; !  * 3  *t  S  •  13  •  £  3  •  •  * D •  '’3D •  _£ ;.:  ■  '£ £;.! 
COnMON  Thh(  e  :•  •  <H?  in* Zn* in*  *.nP*  rh[i.<  ZhO •S'iv 
COnnON  II'ATriiiJi 

COfl’ON  In  • ( nE  *  <  r*E  •  Z"*  *  .•  I VX  *  IVY  *  IUZ  *  IT  •  IN 

CG.hhCH  X?iTT  *  Y *TT • ZhTT  *  I P 


THXS0<1>*0.0 

THXhG<l)*0.0 

CALL  ANlfilT 

TYPE  *»'KEPP  PRESENT  POSITION  ?' 
ACCEPT  *.  I 

IF ( I . NE . 1 )  50  TO  900 

CALL  AlN'SO< lo »2? * I  DAT  A ; 

CALL  A0UT53^,i7*IDATi,) 


Tv c-r  ,t'>,rcr'  jn  e  |  &  ?• 
ACCEPT  t,r  ’■ 

IFd.wE.l;  50  TO  1-0 

TYC£  '•D!  *0.5'' 

ACCEPT  *•*•£< 
h1*1.0-A 

type  **'h£a  INITIAL  3ET ' 

ACCENT  **I 

Irll.NE.l'  5C  TO  12: 

1^*1 

CALL  SLIBhE 

TYPE  * <  'nCT'E  WITHOUT  TjJLE' 
ACCEPT  4. I 
IF(I.NE.l)  50  TO  *00 

nODE  WITHOUT  TA*L£ 

TI*SECNtS <0.0 ) 

T3«3£C.N[:5«C.0» 

CALL  SU&I 

THS'l '»THY5I <*> 

THEC  '«TH:<-3!  '  > 
THS(3'*THY3:^  -THS<  1 ' 

THS<  4)*THX3I ! Z  > 

CALL  SUBS  1 

THt*<  1  ■  Z > 

THn(Zi*THTnI  7: 
THH(3'»Thrnloi-THn'  1  - 
THm 4 )»'H*nI  Z ' 

CAcL  aUBrd 


XS'*a*<"***1  »*3 
YSD«A4t^»A1*^C 


U.bt.  to  DT1C  do##«* 


'tr'C*Z*'iirW.r- 

ZHli=AYI$+A1*Z* 
Sfit=A*53ri]  xlr. 


I 

w 

%X 

i 


,  r 

'it" 


f'n*  1 


XSB=XcI!-i-5t  (XS-x^Z) 
YSD=t'3D+f!«!  T 3-Y:f2  ? 
ZSD=Z5DtB*  ( 7.3-Z3Z ) 
33D=SSDtB*<£S-33Z ) 

XMD»XHD+B*t'XM-XH2> 
YHD*YpiD+Bx(  r'n-Th'  > 
ZMEi-ZHDtB  * Zil-ZiiZ ' 
3HIi=Sh£i+B*(Sn-sHZ) 

CALL  SUBS2 
CALL  SUBH2 


%v 


THSCosTHSCStBio.  THSl6-TH5Ii2) 
T‘irjC6*THftO«+&*(  Th:-J 


:Sj 

f 

V; 


TH  -  '33  •'  2 )  *7"rlS  ( A ) 

THXiC !  3 ) s fH‘3 '  5 '' -TH 3; :-  *0,S25-TH5/3 m0.27 

THY S3  C  a  i  »T-m5 ' 3  >  -<>:*;  *0 . 325- "Wi '  3  >  «0 .  Z7 
TH’xSO^ 5,’ * <  1 1 
TM*5Q(4>*TH3U>+TW3<  T> 

7HXS0t7>*THS<2) 

THXhO(2)*?H^‘  a i 

THXMQ  <3  >*^<5)  -TK'OY  *«) ,  325-THM  <  3X0.27 
THXrfO <  A }■*.-*» <5.*+ "Hn 2-i*C  . SCS-T'-i  ' 3  >  «0 . Z 7 
7HXNCi3)*riHil.' 

THXmO < 6 ; =THn ; 1 i fTHM ( 3  J 
THXM0(7)*rHii*.  2) 


CALL  5UB0 

CALL  AOijTSO(  a*  17 »  I  BA  FA) 

XS2*XSi 

YS2«rSl 

ZS2*ZS! 

ss:*ssi 

XS1=XS 
YS1*’S 
ZSi*ZS 
33l — SS 

XM2*Xrtl 

YH2*rAi 

ZrZ*ZMl 

SH2*Sh; 

XM1»XM 

r«*Y.i 

Zni»ZM 

s«i»sn 


Copy  available  lb  Bn»  _ 

Permit  fuUv  iwriM  *ot 
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c 

c 

c 

170 


c 

c 

c 

w 

c 


180 


c 


c 


c 

20  5 


M  A 


C 


THNIsCs’HHIiO 

THSIil=T'H'!2 

THhl6l=TH«tc. 


T4*SECV0S<T3J 

IT4*AINT(T4*20.0) 

IFCIT4 .L T. 1 )  GO  TO  100 

T2*SECND3tTi) 

IT2*ININ7  (T2? 

IF <  IT2.LT  *60  30  TO  100 

TYPE  if 'NO DE  WITHOUT  TABLE  OR  UITH  TABLE' 

ACCEPT  *» I 

IF  a.  £3.1)  30  TO  90 

TYPE  if'HODE  WITH  TABLE' 

NODE  UITH  TABLE 

TYPE  *» 'COINCIDENCE  OF  TUO  ORIGINS  ?' 
ACCEPT  t,I 

IFd.NE.l)  30  TO  ISO 

TYPE  t,'XHTT<0.0>  YhTT:  0.0*  ZHTTCO.C' 
ACCEPT  t.xriTT.  YriTT •ZfiTT 


CONTINUE 

TYPE  *•  'XS» TS.ZStSS' 

i:iS*ININTiY-j  • 

IYS*ININTTV§) 

irS=ININT(7S) 

[3SslNlHTf  S3.1 

TYPE  *»IXS»IYS»!2S*l>S 

TYPE  tf 
IY‘rf*ININT ( t 
IYM*ININT » YH> 

IZH* ININ r  <  Z7 : 

ISr-INlyT  SH) 

TYPE  if  IXr.f  IVMi  12*  •  I  3H 

TYPE  f * /XHE*VhE*2C!E'»*’£ 
IX!i£=ININT<'Y-'t  > 

IYnE»INIflT  C'*£' 
:7r;E=lNlN":'*F' 
IAn£sIMl«T'.ArE>  _ 

TfPE  »#IX}i£»IY»E»IZhE.iant 

TYPE  i» ' TABLE  SPEED 
ACCEPT  «.I 

IF'I.NE.l)  30  TO  210 
jYpr  i. 'H;X» V/ft lUZ" IT» IN- 

accept  * .  iv* .  ivy .  r'jz .  it f  i.*' 

ttpe  *>• table  gc 
accept  *•!  _ 

I  h  •  I  *  Nt.  »  1 )  GO  1  ^  - *  •* 


Ccpy  av  .,labl«  to  DTIC  do*  no* 
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i 


I 


1 

IS 

s 


I 

8 

I 

Si 

8 

I 

* 

ii 

I 

E 


c 

c 

c 

c 

310 

C 

320 

C 

C 


c 

c 


T^sT-i 

IN=0 

CALL  N0VEdVX-IVY.lv:) 

XI =0.0 
Yt*0.0 
21=0.0 

X2=0.0 
Y2=0 . 0 
22=0.0 

1 1 1  =0 

T6*SECND9'.‘J.0> 

CALL  KQVE  ( IVX  t  IVY  *  IVZ J 
TS=$£CNDS(0.0; 

call  sub: 

THS(l)*TH<5Ii5) 

TH3( 2'=TH'?I 
THS(2>*TKXSI'o>-rWS< 1)- 
THS(4)«THX«I(2> 

CALL  SUBSl 


THHC 1 ;aTK<“!  <T> 
THn(2)=rMf-T ' 

THH ( “ '  =7H> ■;  t  « 
THM(4)=rH.^r.2> 


CALL  SUBhl 

c 

XS£*XS-<2 

yse*ys-y: 

2SE=Z3-22 


C 

Cmiu 

CtUHl 

C 


c 


c 

c 


CALL  SU3HE 

IMX - ?.£AL  5r-££I: 


XSD=A*XH+A1*X5£*x 
r«r**A*  ;•:£>• 

Z30=A*Z‘,-*Ai  «Z3£rZ 
SSC*A«3.TrAi » 33 

XKD*A«XS£mi  r.  h 
r,“0  =  A<  t  - 

ZftD=A*r3E+Ai *z^ 
SWI<*A«SS+A1»> 

ri:*m+i 

IFlIII.ST.O)  GC  TO 

XSEI»*«£ 

YSE2-Y3E 

:s£>:s£ 

352*33 

XM2*XH 


710 


C«PT  otoOoW.  to  [me 
K,a“  <uJI,  I.**. 


nor 

•R 


79 


v»s 

•a 


aSc.1  =  Aoe. 

Y3£i  =  r3f 
Z3£i*Z3E 
331 *33 

AnlsAin 

r.Mi*vn 

Snl=5h 

continue 

<SS»‘SD+f*'  *3£- 
Y'3r,s  Y 3  D + 3  *  (  ’  3"  * 
Z5B*I3t-+P*' ZzZ- 
33ra33i'*: » '  33-3 

ih'.iii  I  *-?• 

fnl^rrl  *C* 
IMD«ZK’*?<*>  £*—i< 

CALI.  5j33C 
CAL-  *C 


THS:»*>  "-V3 
T-<*- 

TH3C  .*  *-*'-•'* 


[H3C*s~~3C'j*:* 
’■-iflCo*  TriC 


TV4X3C"  C  »*- 
TmxSO'  3  *  * 
3C  *  **- 


'Wi *0 1 ;  » *--  a 

*h< «  ■ 

”Ht-J  a  ~ 

**r-c  T  ** —  : 

5  1 

*wx^C'  *  »'-<•  ; 


CAL- 


xr*  x : 


t  *  r  “  t  -  * 

'3EC*i: 

33. *  '  ' 


Copy  available  to  DTIC  doe*  not 
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